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Abstract 


This  paper  deals  with  the  problem,  of  planning  and  controlling  a  radially  symmetric  six¬ 
legged  walker  on  an  uneven  terrain  when  a  smooth  time-varying  body  motion  is  required. 
The  main  difficulties  lie  on  the  planning  of  gaits  and  foot  trajectories.  As  for  the  gaits,  this 
paper  discusses  the  forward  wave  gait  of  a  variable  duty  factor  and  a  variable  wave  direction. 
With  the  commanded  body  motion,  the  maximum  possible  duty  factor  is  computed  using 
the  speed  limit  of  the  leg  swing  motion.  Guaranteeing  this  maximum  duty  factor  contributes 
to  obtain  higher  stability.  We  proved  the  “continuity”  of  this  forward  wave  gait  planning 
algorithm  adds  the  versatility  to  gaits  planned. 

The  foot  trajectory  planning  algorithm  dynamically  generates  a  smooth  foot  trajectory  as 
a  function  of  the  instantaneous  body  motions  by  modifying  standard  leg  motion  templates. 
The  robot  can  negotiate  an  uneven  terrain  by  modifying  a  vertical  leg  motion  by  a  signal 
of  tactile  sensors  on  the  foot.  The  experiments  proved  that  the  robot  can  successfully  track 
smooth  curves  with  body  rotations  on  an  uneven  terrain,  and  thus  proved  the  robustness  of 
the  algorithms. 


1  Introduction 

A  practical  walking  machine  should  be  able  to  walk  versatilely  following  a  continuous  cur¬ 
vature  of  the  commanded  locomotion  trajectory.  Especially,  walking  omnidirectionally  on 
uneven  terrain  is  an  indispensable  feature  of  legged  machines.  This  research  is  related  to  a 
radially  symmetric  six  legged  robot,  which  has  an  advantage  of  having  a  uniform  performance 
in  an  arbitrary  crab  angle. 

A  number  of  periodic  gait  planning  methods  for  six-legged  walker  have  aheady  been 
proposed  [1]  -  [10].  For  six-legged  robots,  the  tripod  gait  is  the  simplest  periodic  gait, 
in  which  two  sets  of  tripods  move  alternately.  Although  the  control  method  of  this  gait  is 
simple,  it  is  appropriate  only  at  a  specific  speed  as  seen  later.  We  want  a  more  general  gait 
planning  algorithm  which  gives  larger  stability  for  a  slower  speed. 

The  (forward)  wave  gait  for  a  longitudinally  symmetric  multi-legged  robot  is  a  gait  in  which 
a  wave  of  lift-off  events  propagates  forward  along  each  side.  Song  and  Waldron  demonstrated 
that  the  wave  gait  provides  the  largest  stability  margin  at  any  given  duty  factor  on  a  lon¬ 
gitudinally  symmetric  six  legged  walker  [2].  It  seems  to  have  largest  stability  margin  for  a 
radially  symmetric  walker  also  [3].  This  research  issue  was  systematically  investigated  by 
Zhang  and  Song  [4].  However,  the  conventional  wave  gait  had  limitations  in  at  least  two 
aspects.  A  larger  duty  factor  means  a  larger  stability  margin.  Therefore,  we  should  use  the 
maximum  duty  factor  determined  by  the  robot’s  commanded  speed  and  the  leg’s  maximum 
swing  speed,  which  are  generally  variable  over  time.  In  the  conventional  wave  gait,  a  duty 
factor  is  kept  constant  and  cannot  be  changed  when  walking  [2].  This  is  the  first  of  the  two 
limitations. 
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In  order  to  obtain  larger  stability,  it  is  essential  for  a  walker  to  have  its  wave  propagating 
direction  equal  to  the  desired  crab  angle  when  walking  (A  crab  angle  is  the  motion  direction 
in  the  robot’s  coordinate  system).  However,  it  is  not  possible  in  the  conventional  wave  gait 
to  continuously  change  the  wave  propagating  direction  when  walking.  This  is  the  second 
limitation.  This  capability  of  changing  the  wave  propagation  is  needed  for  a  walking  robot 
to  track  a  curved  trajectory.  Lee  and  Orin  proposed  a  method  to  change  the  crab  angle 
by  using  only  two  wave  propagation  directions:  backward  or  forward  [5].  However,  in  this 
gait,  the  wave  propagation  direction  and  crab  angle  are  not  the  same  and  some  hysteresis  is 
unavoidable  in  the  direction  switching.  A  gait  is  said  to  be  semi-periodic  if  its  duty  factor 
or  relative  phases  are  variable  over  time.  In  this  paper,  we  will  show  a  variable  parameter 
gait  planning  algorithm  which  generates  semi-periodic  gaits  with  a  variable  speed,  with  a 
variable  motion  direction,  and  with  a  variable  body  rotation,  answering  the  aforementioned 
research  questions.  More  specifically,  this  algorithm  embodies  the  best  duty  factor  and  the 
best  combination  of  relative  phases  for  each  leg  under  a  given  motion  command.  The  main 
theoretical  results  in  this  paper  are  explicitly  stated  in  three  Propositions.  The  computation 
time  for  this  algorithm  is  much  less  than  that  for  fully  intelligent  free  gait  planning  algorithms 
[11]  [12].  This  algorithm  generates  not  only  the  conventional  wave  gaits  (such  as  tripod  gaits), 
but  other  useful  gaits  as  well. 

As  for  the  trajectory  of  a  transferring  foot,  Lee  and  Orin  [1,  5]  described  an  algorithm  for 
a  foot  to  follow  the  body  motion.  They  used  a  rectangle  trajectory,  which  is  not  suitable 
for  smooth  foot  motion.  Sakakibara  and  Hirose  proposed  to  use  a  smooth  foot  trajectory,  in 
which  the  next  foothold  must  be  determined  by  the  time  of  its  lift-off.  Hence,  their  algorithm 
cannot  execute  a  curved  body  trajectory  [13, 14] .  The  features  of  the  foot  trajectory  planning 
algorithm  investigated  in  this  paper  are  (i)  a  smooth  foot  trajectory  template  is  adopted,  (ii) 
omni-directional  motion  commands  are  allowed,  (iii)  footholds  are  dynamically  determined 
in  order  to  deal  with  the  omni-directional  motions,  and  (iv)  each  foot  velocity  is  dynamically 
evaluated  because  of  the  foothold  point’s  possible  motion.  The  algorithm  stated  here  is  the 
most  general  one  among  others  reported  so  far,  because  the  method  by  [5]  satisfies  (ii)  and 
(iii),  but  not  (i),  and  because  the  method  given  by  [13,  14]  satisfies  (i),  but  neither  (ii)  nor 
(iii). 

The  activities  described  in  this  paper  are  related  to  the  robot  AQUAROBOT,  which  was 
constructed  by  the  Port  and  Harbour  Research  Institute  (PHRI),  Ministry  of  Transport 
of  Japan.  PHRI  has  constructed  three  experimental  six-legged  underwater  walking  robots, 
AQUAROBOT,  for  underwater  inspection  tasks  (Fig.  1).  The  second  version  was  tested  in 
a  real  enviroment.  The  task  was  to  inspect  the  evenness  of  a  rubble  mound  of  size  of  42  x  77 
meters  at  an  average  depth  of  24  meters  in  the  caisson  yard  for  Kamaishi  Bay  Breakwaters 
[16,  17]. 

This  research  was  a  part  of  the  international  cooperated  research  project  administered 
mainly  by  the  Naval  Postgraduate  School  (NPS)  in  the  US  and  PHRI  [15].  The  research 
activities  in  the  US  have  been  mostly  supported  by  the  National  Science  Foundation  for 
three  years  beginning  in  February  1992.  Activities  in  Japan  have  been  partially  supported 
by  the  Science  and  Technology  Agency  for  the  Japanese  fiscal  year  of  1993  [18, 19].  One  of  the 
purposes  of  this  research  project  was  to  improve  the  performance  of  these  underwater  walking 
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robots  through  international  collaboration,  and  more  specifically,  to  make  its  walking  speed 
faster.  An  implementation  of  these  algorithms  was  done  on  the  AQUAROBOT  system 
for  evaluating  their  correctness  and  efficiency.  The  successful  results  proved  not  only  the 
correctness,  but  a  fact  that  the  algorithms  require  only  modest  computation  time  to  make 
real  time  control  of  the  robot  hardware  possible.  The  research  goals  of  this  whole  project 
also  included  linkage  dynamics,  virtual  reality  simulation  model,  and  task  and  mission  level 
control  architecture  [22,  23,  24]. 


2  Problem  Statements  and  Overview  of  the  Control 
System 


The  objective  of  this  research  is  to  find  a  leg  motion  planning  algorithm  for  a  radially  sym¬ 
metric  walking  robot  to  embody  smooth  continuous  body  motion  commands  on  an  uneven 
terrain  with  optimal  stability.  The  input  to  this  algorithm  is  a  rigid  body  motion  specifi¬ 
cation  to  the  robot  and  the  output  is  a  description  of  foot  motions.  The  difficulties  of  this 
problem  lie  in  the  fact  that  the  gait  must  have  larger  stability  for  any  situation,  that  the  leg 
motion  must  be  smooth  and  must  negotiate  a  terrain  roughness,  that  the  body  rotation  may 
be  superimposed  on  translational  motion,  that  the  body  speed  may  change  with  a  real-time 
command. 

In  order  to  solve  the  problem  of  realizing  a  versatile  control  algorithm  as  stated  above, 
we  propose  a  global  hierarchical  architecture  of  the  control  system  as  shown  in  Figure  2. 
The  body  motion  description  block  provides  a  smooth  body  motion  command  to  follow 
a  path  which  specified  for  global  robot  tasks.  Once  the  body  motion  command  is  given, 
the  gait  planning  block  generates  a  sequence  of  the  legs’  lift-off  and  touch-down  events  to 
produce  a  larger  stability  margin.  A  static  stability  margin  on  an  uneven  terrain  is  defined 
the  same  as  that  on  a  flat  terrain.  Thus,  this  gait  planning  algorithm  is  available  also  on 
an  uneven  terrain.  The  gait  is  specified  by  a  duty  factor  and  relative  phases.  Hence,  the 
gait  planning  block  has  a  function  to  decide  a  duty  factor  and  relative  phases  based  on  the 
body  motion  command.  The  foot  trajectory  planning  block  generates  a  foot  motion  that 
allows  the  body  to  follow  the  commanded  motion.  It  includes  an  uneven  terrain  negotiation 
algorithm.  The  foot  motion  is  planned  in  the  world  coordinate  system,  and  translated  to 
the  body  coordinates  to  calculate  joint  angular  rates. 


3  Gait  Planning 

3.1  Principle 

A  body  motion  of  a  walking  robot  is  basically  described  by  six  degrees  of  freedom,  since 
the  body  moves  in  the  three  dimensional  space.  However,  in  order  to  make  the  problem 
simpler,  we  assume  that  its  height  is  constant,  and  its  pitch  and  roll  angles  are  null.  Thus, 
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the  robot’s  motions  are  confined  in  a  horizontal  plane.  Therefore,  in  this  paper,  a  motion 
command  is  given  by 

Q{t)=  (y{t),e{t),u{t)),  (1) 

where  v{t)  (>  0)  is  the  horizontal  translational  motion  speed,  9{t)  the  horizontal  translational 
motion  direction,  and  uj{t)  the  rotational  velocity  (about  z  axis)  of  the  robot  respectively 
[25].  This  (instantaneous)  motion  command  Q{t)  is  the  input  to  the  gait  planning  algorithm; 
the  output  is  a  set  of  up-and-down  timings  of  the  leg  expressed  by  a  duty  factor  I5{t)  and 
relative  phases  ^,(t)  for  leg  i. 

Since  v,  0  and  u  are  variables  of  time,  the  motion  speed  may  be  changing,  the  motion 
trajectory  may  be  curved,  and  the  robot’s  heading  direction  may  not  be  equal  to  its  motion 
direction  9{t).  Therefore,  the  problem  of  optimizing  the  stability  all  the  time  is  not  trivial. 

In  order  to  solve  this  problem  of  maximizing  stability,  a  new  concept  of  variable  parameter 
forward  wave  gait  is  introduced.  In  a  regular  gait  [6],  the  duty  factor  P{t)  is  the  ratio  of  the 
supporting  interval  to  the  cycle  time.  We  first  find  the  maximum  duty  factor  /?max  for  a  given 
motion  command  Q{t).  Next,  we  embody  this  maximum  duty  factor  /?max  by  continuously 
changing  0{t).  This  method  works  to  obtain  larger  stability. 

A  crab  angle  a{t)  is  the  difference  between  the  robot’s  heading  (direction  of  leg  1)  and  body 
motion  direction  9{t).  The  relative  phase  tpi  of  leg  i  is  the  touch-down  instance  normalized 
by  one  cycle  time.  The  legs  are  numbered  as  shown  in  Figure  3.  A  crab  angle  a  divides  the 
six  legs  into  two  groups:  left  and  right.  (In  a  special  case  where  the  body  motion  direction 
equals  to  the  direction  of  one  leg,  assume  that  both  left  and  right  leg  groups  include  the 
forefront  and  rearmost  legs.)  A  forward  wave  gait  for  a  radially  symmetric  walking  robot  is 
defined  as  a  gait  in  which  the  wave  of  touch-down  events  propagates  forward  in  each  group, 
and  the  phase  difference  between  the  neighbors  in  each  group  is  1  -  /?.  That  means  when 
one  leg  touches-down,  the  next  one  is  lifted-off.  In  the  conventional  forward  wave  gait,  the 
phase  difference  between  two  groups  is  1/2  so  that  the  two  legs  in  a  longitudinally  symmetric 
positions  move  alternately  each  other.  However,  in  a  radially  symmetric  walker,  the  phase 
difference  between  two  groups  may  not  be  necessarily  equal  to  1/2.  The  gait  planning 
algorithm  developed  here  generates  the  conventional  forward  wave  gait  as  a  special  case 
where  Oi{t)  —  {2n  —  l)7r/6.  No  jerky  motion  occurs  in  any  case,  because  the  gait  generator 
function  is  continuous. 

When  the  body  motion  direction  changes  over  time,  we  continuously  change  the  wave 
propagating  direction  so  that  both  of  directions  become  equal.  This  method  also  contributes 
to  obtain  larger  stability. 

A  regular /periodic  gait  is  normally  described  by  a  duty  factor  0  and  a  set  (^i,  •  •  • ,  ^jq)  of 
relative  phases,  which  are  constant  over  time.  However,  in  this  paper,  the  duty  factor  /3{t) 
and  the  relative  phases  'tpi{t)  are  functions  of  time  and  defined  more  generally  as  follows.  A 
variable  parameter  forward  wave  gait  is  a  collection  of  regular  and  periodic  reference  gaits 
Q{t).  That  means,  at  each  given  time  ti,  the  gait  Q{ti)  is  a  regular/periodic  gait.  Its  duty 
factor  P{ti)  and  relative  phases  ^i(ti)  are  defined  as  ones  of  the  instantaneous  reference 
regular/periodic  gait  G{ti).  Other  instantaneously  definable  values,  such  as  positions  and 
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velocities  of  the  legs,  are  also  those  of  the  reference  gait. 

Under  this  variable  parameter  forward  wave  gait  planning  method,  we  define  a  gait  gener¬ 
ator  '^i{i  =  1,  •  •  • ,  6)  of  a  crab  angle  a{t)  and  a  duty  factor  0{t)  to  obtain  a  relative  phase 
tpi{t)  of  leg  i: 

tPi{t)  =  '^i(a{t)Jit))  i  =  l,  ...,  6  (2) 

A  gait  generator  must  be  a  continuous  function  of  Q;(f)  and  0{t)  in  order  to  obtain 
dynamically  changing  gaits  when  the  parameters  a{t)  and  0{t)  change.  A  discontinuity  in 
a  relative  phase  causes  jerky  leg  motion.  For  instance,  if  'F,-  is  discontinuous,  a  free  leg  may 
need  to  become  a  support  one  instantaneously,  even  when  the  leg  is  still  horizontally  moving. 


3.2  M2iximum  Duty  Factor 

In  a  regular  gait  without  rotation,  an  average  velocity  of 

is  required  for  a  swing  leg  [14],  where  0{t)  is  a  duty  factor  and  v(t)  its  motion  speed.  The 
duty  factor  defined  in  Section  3.1  is  still  valid  for  a  variable  parameter  gait.  In  a  motion 
with  a  translational  component  v{t)  and  a  rotational  component  the  average  velocity 
u{t)  at  the  outermost  leg  is 


(4) 


where  R  is  the  distance  from  the  body  center  to  the  outermost  point  of  a  leg’s  constrained 
working  area.  If  Umax  denotes  the  maximum  swing  velocity. 


0{t)  = 


u{t) 


< 


U„ 


v(t)  +  |a;(i)|  R  +  u(t)  “  u(<)  +  |a;(t)|  i?  +  U 


—  0ma.x{t^t 


(5) 


where  0max{t)  denotes  the  maximum  duty  factor.  This  value  0ma.x{t)  is  the  upper  limit  of  the 
duty  factor  for  any  foot  position  [19].  From  now  on,  we  try  to  realize  this  velocity-dependent 
maximum  duty  factor  0max{t)  all  the  time  in  order  to  obtain  the  maximum  stability. 


3.3  Varying  the  Duty  Factor 

Now  we  want  to  find  a  set  of  relative  phases  of  all  six  legs  satisfying  the  maximum  duty 
factor  0rna.x{t)  givcu  by  Equation  (5)  so  as  to  optimize  the  stability  margin.  We  first  consider 
the  case  in  which  the  crab  angle  ct  =  tt/G  and  the  commanded  velocity  is  changing.  Namely, 
we  will  find  the  function  value  ^i(7r/6,j0)  in  this  Section. 

Figure  4  shows  the  conventional  wave  gait  diagram  for  0  =  5/6,  2/3,  and  1/2.  In  order  to 
find  a  continuous  function  ^^j/tt/G,/?)  with  1/2  <  /?  <  2/3,  we  design  a  gait  pattern  shown  in 
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Figure  5.  The  upper  and  lower  solid  segments  of  each  leg  show  a  support  phase  at  /?  =  2/3 
and  /?  =  1/2  respectively.  The  segments  for  /?  =  1/2  in  Figure  5  were  shifted  by  a  1/4  phase 
from  those  in  Figure  4  in  order  to  minimize  the  total  amount  of  the  phase  variations  between 
two  cases.  By  linearly  interpolating  these  two  segments,  the  relative  phase  for  an  arbitrary 
duty  factor  (5  6  [1/2, 2/3]  is  obtained  as  shown  by  the  broken  line  segments  in  the  Figure. 

Furthermore,  by  linear  extrapolation,  we  simply  obtain  a  gait  generator  set  as 

(i  =  lto6)  (6) 

for  the  full  duty  factor  range  of  (0,  Ij.  Thus,  the  relative  phase  V’i  for  a  =  7r/6  is  found  as  a 
linear  continuous  function  of  p.  This  gait  class  is  shown  in  Figure  6. 

Proposition  1  There  exists  a  continuous  gait  generator  of  j3  such  that  /?)  is  a 

forward  wave  gait  for  any  duty  factor  P  G  (0, 1] . 

Proof.  Since  a  =  7r/6,  the  left  leg  group  is  (5,  6,  1)  and  the  right  leg  group  is  (4,  3,  2)  from 
the  rear  to  the  front  respectively.  Consider  the  gait  class  shown  in  Figure  6  and  Equation  (6). 
The  touch-down  timing  of  leg  5  is  equal  to  the  lift-off  timing  of  leg  6,  and  the  tough-down 
timing  of  leg  6  is  equals  to  the  lift-off  timing  of  leg  1  for  any  duty  factor.  The  same  relation 
holds  in  the  other  side.  The  phase  differences  of  the  touch-down  timings  of  leg  pairs  (1,  2), 
(6,  3),  and  (5,  4)  are  1/2  respectively.  Thus,  the  gaits  generated  by  Equation  (6)  are  forward 
wave  gaits.  I 

Figure  7  shows  supporting  leg  combinations  at  a  kinematic  phase  (p  (a  time  normalized  by 
one  cycle  time)  [1]  for  a  given  duty  factor  During  its  motion,  a  robot’s  state  corresponds  to 
a  point  with  the  current  0  and  (p  in  the  chart.  If  a  robot  is  walking  at  a  constant  translational 
speed  V  without  rotation,  the  robot’s  state  moves  along  the  horizontal  line  at  the  duty  factor 
P  given  by  Equation  (5).  In  a  special  case  of  ^  =  1/2,  this  extended  wave  gait  becomes  the 
well-known  tripod  gait.  When  the  robot  increases  its  current  translational  speed  v{t),  the 
current  duty  factor  P{t)  decreases  according  to  Equation  (5)  and  the  robot’s  state  moves 
downward  in  this  chart  as  its  kinematic  phase  proceeds. 

A  gait  with  a  duty  factor  <  1/2  is  statically  unstable  for  a  six  legged  walker.  However, 
some  of  these  gaits  are  still  stable  for  a  walker  with  more  than  six  legs. 


3.4  Varying  the  Crab  Angle 

In  this  Section,  we  are  finding  a  wave  gait  planning  method  when  its  crab  angle  a{t)  is 
variable.  We  first  plan  gaits  for  a  variable  crab  angle  a{t)  with  a  fixed  duty  factor  P  =  2/3. 
In  Figure  8,  for  each  leg,  the  upper  line  segment  shows  its  supporting  interval  with  a  =  7r/6, 
and  the  lower  line  segment  with  a  =  — tt/G  {P  =  2f3  in  both  cases).  By  interpolating  these 
two  segments,  we  obtain  a  gait  for  an  arbitrary  intermediate  crab  angle.  This  intermediate 
gait  should  also  be  classified  into  a  forward  wave  gait,  because  a  wave  of  lift-off  events 
propagates  forward. 


For  this  fixed  duty  factor,  it  is  straightforward  to  obtain  a  gait  with  a  crab  angle  in  the 
expanded  range  of  [0, 27r)  taking  into  account  of  hexagonal  symmetry.  Figure  9  shows  the 
relative  phase  function  ^,(a, /d)  for  =  2/3  and  /?  =  1/2.  These  functions  are  explicitly 
described  as  follows: 


For  i  =  1,3,5, 


r  a'/(2n) 

1/3 

—a!  I  {2%)  +  5/6 
0 

=  1/4. 


(  0  <  a'  <  27r/3), 

(27r/3  <ot'<  tt), 

(  TT  <  a'  <  57r/3), 
(57r/3  <  a'  <  27r), 


where. 


For 


=  2,4,6, 

i) 


'  a7(27r)  +  l/2 
5/6 

-a7(27r)  +  l/3 

i  1/2 

=  3/4, 


(  0  <  a'  <  27r/3), 

(27r/3  <  a'  <  tt), 

(  IT  <  a'  <  57r/3), 
(57r/3  <  a'  <  27r), 


(2*  —  l)7r 
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mod 


(7) 

(8) 


Proposition  2  There  exists  a  continuous  gait  generator  of  a  such  that  ^i(a,  2/3)  is  a 
forward  wave  gait  for  any  crab  angle  a  €  [0,27r). 


Proof  Consider  the  class  of  gaits  shown  in  Figure  9  and  Equation  (7).  The  touch-down 
events  propagate  from  the  rear  to  the  front  for  any  crab  angle,  and  the  phase  lag  of  each 
leg  to  the  neighboring  one  is  1/3.  The  phase  differences  of  left  and  right  legs  are  1/2  for 
a{t)  =  (2n  -  l)7r/6.  Thus,  the  gaits  generated  by  Equation  (7)  are  forward  wave  gaits.  2 

Now  we  consider  the  cases  in  which  the  duty  factor  is  also  variable.  In  order  to  plan  a  gait 
for  an  arbitrary  combination  of  a  and  /?,  we  combine  the  algorithm  described  in  Section  3.3 
and  the  previous  result  (7).  By  substituting  each  occurrence  of  7r/6  in  Equation  (6)  by  a, 
we  obtain 


*,(a./?)=[6((/?-i)4'i(o.|)-(/?-i)«i(Q4))]„^,  (i  =  lto6),  (9) 

where  |)  and  ^,(0,  |)  are  obtained  by  Equation  (7).  That  is,  this  algorithm  generates 
a  linear  inter/extrapolation  for  both  parameters  of  a  crab  angle  and  a  duty  factor. 

Proposition  3  There  exists  a  continuous  gait  generator  of  a  and  (5  such  that  ^1(0:,  /3) 
is  a  forward  wave  gait  for  any  crab  angle  a  €  [0, 27r)  and  for  any  duty  factor  (5  €  (0,  Ij. 
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Proof.  Consider  the  class  of  gaits  given  by  Equation  (9).  The  phase  lag  of  each  leg  to  the 
neighboring  one  is  1/3  in  |),  and  is  1/2  in  i)  as  demonstrated  in  Proposition  2. 
By  substituting  these  values  for  |)  and  i),  we  find  the  total  phase  lag  being 
—  p.  That  means  the  gaits  generated  by  Equation  (9)  are  forward  wave  gaits.  I 

Figure  10  shows  the  supporting  leg  combination  for  a  crab  angle  a  =  0.  Compare  this  result 
with  Figure  7. 


3.5  Gait  Examples 

Figure  11  shows  an  example  of  a  gait  generated  for  a  fixed  crab  angle  and  variable  duty 
factor.  The  lines  in  the  top  part  indicate  the  supporting  phases  the  legs.  The  horizontal 
coordinate  means  time.  The  symbols  in  the  lower  part  indicate  positions  and  postures  of  the 
robot  at  a  constant  interval.  The  locomotion  speed  increases  as  the  robot  moves  to  the  right. 
The  duty  factor  decreases  and  the  cycle  time  of  the  gait  decreases  as  the  speed  increases. 
For  any  duty  faetor,  the  lift-oflF  events  propagate  from  the  rear  to  front  as  the  arrows  show. 

Figure  12  shows  an  example  of  a  gait  generated  for  a  variable  crab  angle  and  a  fixed  duty 
factor.  The  hatched  arrows  indicate  the  correspondence  between  robot  positions  and  leg 
states.  The  locomotion  speed  is  constant  in  this  case.  The  crab  angle  is  tt/S  at  first,  then  is 
changed  to  zero,  and  finally  becomes  -tt/S.  For  any  crab  angle,  the  lift-off  events  propagate 
from  the  rear  to  front  as  the  arrows  show. 

The  stability  margin  [8]  is  defined  as  the  ratio  C/D,  where  C  is  the  horizontal  distance 
between  the  body  center  and  the  nearest  edge  of  the  convex  hull  formed  by  the  supporting 
feet,  and  D  is  the  horizontal  distance  from  the  body  reference  point  to  a  foot  in  the  standard 
posture  of  the  robot.  Figure  13  shows  the  stability  margins  obtained  by  simulation  for  three 
distinct  cases.  The  first  one  shown  in  a  solid  line  is  the  result  for  a  variable  parameter  forward 
wave  gait  along  a  circular  path  with  a  constant  body  orientation  in  the  world  coordinate 
system  (a  variable  crab  angle  gait).  The  second  one  shown  in  a  broken  line  is  the  result  for 
a  classical  forward  wave  gait  with  a  =  tt/G  along  a  straight  path.  The  third  one  shown  in 
a  dotted  line  is  the  result  for  a  backward  wave  gait  along  a  straight  path.  Notice  that  the 
stability  margin  of  variable  parameter  forward  wave  gaits  and  that  of  fixed  crab  angle  forward 
wave  gaits  are  not  much  different  and  they  are  significantly  better  than  that  of  backward  wave 
gaits.  This  observation  is  consistent  with  what  was  proved  on  a  longitudinally  symmetric 
walker  [2]. 


4  Foot  Trajectory  Planning 

4.1  Objectives 

The  problem  of  foot  motion  planning  for  a  walking  robot  is,  given  its  gait,  determining 
appropriate  trajectories  of  the  feet  in  the  space  to  embody  the  gait. 
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The  inputs  to  the  algorithm  are  the  body  motion  command,  gait  parameters  such  as  /? 
and  and  the  robot’s  state  variables  such  as  the  phase  variables,  foot  positions  and  foot 
speeds.  Notice  that  these  inputs  are  dynamic.  The  outputs  are  commanded  speeds  to  the 
joints.  Therefore,  this  algorithm  obtains  optimal  foot  motions  at  every  sampling  time  in  a 
time-varying  body  commanded  motion.  After  defining  fundamental  concepts  in  foot  motion 
planning,  we  describe  desirable  properties  for  foot  motions  and  next  we  design  an  algorithm 
to  plan  such  kind  of  foot  trajectories. 


4.2  Computing  Phase  Variables 


Evaluating  phase  variables  is  essential  in  the  periodic  behavior  of  a  walking  robot.  The 
method  described  in  this  Section  is  based  on  the  work  by  Lee  and  Orin  [5]. 

The  concept  of  the  constrained  working  volume  (CWV  in  short)  of  a  leg  is  essential  in  foot 
trajectory  design  [5].  This  concept  was  introduced  to  analyze  interference  among  legs  and 
to  implement  the  spatial  aspect  of  semi-periodic  gait  [5].  Generally  the  reachable  volumes  of 
all  the  feet  of  a  robot  overlap  each  other.  In  this  paper,  a  cylindrical  subset  of  the  reachable 
volume  of  a  leg  is  defined  as  the  CWV  of  the  leg  in  such  a  way  that  the  CWVs  of  any  two 
legs  do  not  have  intersections  (the  radius  of  the  cylinder  is  rcwv).  This  decision  makes  the 
foot  trajectory  computation  task  simpler. 


The  temporal  kinematic  margin  tsi  of  leg  i  is  a  predicted  time-to-go  until  the  foot-tip  of 
leg  i  in  the  support  phase  reaches  the  surface  of  the  CWV  with  the  present  foot  velocity.  By 
this  definition  [5], 


d 


(10) 


where  vpi  is  the  present  foot  velocity  of  leg  i  relative  to  the  body  and  d  is  the  distance  from 
the  support  point  to  the  surface  of  the  CWV  in  the  direction  of  vpi.  The  kinematic  period 
T  is  given  by  [5] 


r  = 


1  . 
-mm 
P  * 


tsi  1 
1  -  J 


(11) 


The  leg  phase  variable  (pn  which  determines  the  phase  of  the  leg  i  is  defined  as  [5]: 


where. 


4^ Li  —  [0  modi , 


(12) 


0  <(f>Li  <  0  support  phase, 

<  0ii  <  1  transfer  phase. 

The  support  phase  variable  4>si  ^  [0, 1] of  leg  i,  which  represents  the  phase  during  its  support 
phase,  being  0  at  the  touchdown  and  1  at  the  lift-off  is  computed  as  follows  [5]: 

<l>Si  =  (13) 
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The  transfer  phase  variable  (pn  €  [0, 1]  of  leg  i,  which  represents  the  phase  during  its  transfer 
phase,  being  0  at  the  lift-off  and  1  at  the  touchdown  is  computed  as  follows  [5]: 


(hi  = 


^Li  -  P 

1-^  ■ 


(14) 


4.3  Transfer  Phase:  Trajectory  Design 

This  Section  discusses  a  foot  motion  planning  algorithm  in  the  period  while  a  foot  is  moving 
(or  transferring).  A  foot  trajectory  is  a  curve  in  the  three-dimensional  space  and  there  exist 
tremendous  number  of  distinct  curve  classes  for  our  purpose.  We  specifically  selected  a 
trajectory  class  for  foot  motions  which  satisfies  the  following  requirements. 

(i)  Trajectories  are  smooth  so  that  acceleration  of  legs  is  easier  for  the  motor  controllers  and 
foot  motions  would  not  give  bad  reactions  to  the  body. 

(ii)  Trajectories  have  vertical  portions  at  landing  and  leaving  periods  in  order  not  to  cause 
horizontal  slippage  of  the  feet. 

(iii)  Vertical  foot  motions  at  landing  must  be  decelerated  in  order  to  reduce  the  landing 
impacts  [13,  14]. 

(iv)  Omni-directional  body  motions  must  be  embodied. 

(v)  Each  foot  trajectory  is  constrained  in  a  vertical  flat  plane  named  called  a  foot  trajectory 
plane  to  simplify  the  trajectory  design  task. 

(vi)  Each  trajectory  (in  a  trajectory  plane)  is  generated  by  a  foot  trajectory  template  to  make 
the  generation  task  easier.  Because  of  Requirement  (i),  the  trajectory  template  must  also 
be  smooth. 

As  we  see  later,  we  found  these  requirements  were  effective  to  control  the  robot  in  real  time 
and  to  make  the  resultant  motions  smooth  and  natural. 

We  adopted  a  trajectory  which  satisfies  the  previous  requirements  in  Figure  14,  Part 
(a).  Part  (b)  shows  the  vertical  and  horizontal  velocities  to  generate  the  trajectory.  A 
foot  trajectory  instance  is  generated  depending  on  each  dynamic  situation  on  the  current 
trajectory  plane  based  on  the  trajectory  template. 

Let  €  [0, 1]  denote  the  transfer  phase  variable  of  leg  i,  which  represents  the  phase 
during  its  transfer  phase,  0  at  the  lift-off  time  and  1  at  the  touch-down  time.  This  variable 
hi  describes  each  foot  motion  as  shown  in  Figure  14,  Part  (b).  The  horizontal  velocity 
and  vertical  velocity  are  normalized. 

As  a  part  of  foot  trajectory  planning  task,  each  leg’s  next  precise  foothold  position  should 
be  evaluated  at  each  sampling  time.  The  foothold  position  determines  the  foot  trajectory 
instance.  The  next  foothold  position  should  be  determined  in  relation  to  the  motion  of 
CWV. 

First,  we  find  the  horizontal  velocity  of  foothold  position  on  Xw-Yw  plane.  Let  = 

{pLix,PLiy,PLizY  be  the  CWV  center  of  leg  i  in  the  world  coordinate  system,  and  = 

{vLix,VLiy,VLizV  the  velocity  of  the  CWV  center  in  the  world  coordinate  system.  The 
predicted  foothold  ^PpHi  —  {PFHixiPFHiy^PvHizY  in  the  world  coordinate  system  is  computed 
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as  the  intersection  of  the  edge  of  the  CWV  and  the  ray  drawn  from  the  CWV  center  in  the 
^vii  direction.  Therefore,  at  the  end  of  the  transfer  phase(0Tj  =  1),  the  predicted  foothold 
position  will  be 

PFHix=PLix  +  (1  ~  4'Ti)TTVLix  +  “7=1==^=’  (1^) 

+  Viiy 

PFHiy=PLiy  +  (1  ~  4>Ti)TT'0Liy  +  “?=f====%=)  (1^) 

V  +  niy 

where  is  the  transfer  period. 


4.3.1  Negotiation  with  Uneven  Terrcdn 


Next,  let  us  discuss  the  issue  of  how  to  negotiate  with  uneven  terrains.  We  first  assume  that 
the  robot’s  terrain  is  globally  flat  and  there  exists  a  local  variance  in  the  vertical  unevenness 
of  ±h.  The  average  height  of  the  terrain  is  called  the  ground  level,  where  z  =  zq.  To  adapt 
this  much  terrain  roughness,  vertcal  component  of  a  foothold  position  is  initially  planned 
at  a  hight  below  the  ground  level  by  h.  In  a  real  robot’s  operation,  the  phase  of  a  foot  is 
switched  from  a  transfer  to  support  phase  when  its  tactile  sensor  sends  a  signal.  By  this 
feedback  mechanism,  the  robot  can  negotiate  an  uneven  terrain. 


PFHiz  =  < 


Zo  -  h, 

Zq  —  Hi, 
Zq  +  h. 


for  0  <  (pTi  <01,  02  <  (pTi  <  03, 
for  01  <  (pTi  <  02, 
for  03  <  0Ti  <  1, 


(17) 


where  0i,02  and  03  are  the  phases  when  a  foot  reaches  a  height  of  h,  a  clearance  height  of 
Hi  and  a  height  of  —h  respectively  (Figure  14). 


So  far  we  consider  environments  in  which  the  ground  is  globally  horizontal  with  the  ground 
level  of  Zq  even  though  there  is  a  small  disturbance  of  ±h.  If  a  terrain  is  globally  not 
horizontal,  we  propose  the  following  method  to  negotiate  it. 

A  local  terrain  is  approximated  by  a  plane 

z  =  Ax  +  By  +  C,  (18) 

where  A,  B,  and  C  are  constant.  These  are  computed  by  the  latest  three  supporting  foot 
positions.  Then  the  current  terrain’s  height  zq  is  dynamically  evaluated  as 

Zq  =  ApFix  A  BpFiy  +  C.  (19) 

Since  the  robot  can  negotiate  the  unevenness  of  ±h  from  this  variable  zq,  it  can  walk  on  a 
slope  as  well  with  a  semi-periodic  gait. 


4.3.2  Dynamic  Trajectory  Planning 

If  the  robot  is  steadily  walking  at  a  constant  speed  and  a  direction,  the  trajectory  plane 
of  each  foot  has  the  same  direction  as  the  body  translation  direction,  and  the  stride  and 
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trajectory  of  each  foot  are  the  same.  However,  if  the  motion  commands  are  changing, 
the  trajectory  plane  may  be  bent  and  may  be  shrunk  or  stretched  to  coordinate  with  the 
commanded  motions.  The  directions  of  the  trajectory  planes  are  not  equal.  The  strides 
and  speeds  of  all  legs  may  not  be  equal  anymore.  Such  an  algorithm  is  needed  to  embody 
omni-directional  body  motions.  This  capacity  is  implemented  by  calculating  an  appropriate 
foot  speed  as  described  below. 


When  a  body  motion  command  is  a  variable  over  time,  a  foot  trajectory  needs  to  be  ex¬ 
panded  or  shrunk  elastically  and  this  is  possible  through  changing  the  coefficients  ^h,^v 
of  trajectory  templates.  Hence  the  foot  velocity  ^vpi  of  leg  i  at  the  foot  position  of 
^Ppi  =  {PFixiPFiyiPFiz)  in  the  world  coordinate  system  becomes 


Vpi  = 


PjHiy-VFiy  ^  (0  ) 


(20) 


where 


r  02,  for  0  <  (j)Ti  <  02 
\  1.  for  02  <  0Ti  <  1 


(21) 


The  foot  speed  represented  in  the  world  coordinate  system  is  converted  into  the  body  co¬ 
ordinate  system  and  next  translated  into  robot-dependent  joint  velocities  using  an  inverse 
Jacobian  matrix. 


n,,  ^Bt)(W.,  w.,  w.  ,  ^  \  /■oo\ 

Vpi  —  w^K  ^Fi—  V  —  iO  X  Ppi),  {22) 

where  is  the  rotation  matrix  from  the  world  to  the  body  coordinate  system  [26] . 

0i  =  J~\0i)  %Fi  (23) 

where  0i  =  [^1,^2,  ^3]  is  joint  angules  of  each  leg,  and  its  derivative  0  is  joint  angular 
velocities.  This  final  joint  angular  velocities  are  applied  to  the  actuators. 


4.4  Support  Phases  .  . . . 

In  a  support  phase,  a  foot  must  move  in  such  a  way  that  the  body  makes  continuous  motion  as 
specified  by  the  command.  The  supporting  foot  position  for  each  leg  in  the  world  coordinate 
system  is  assumed  stationary  during  its  support  phase.  Therefore,  the  foot  velocity  ^vpi 
relative  to  the  body  is  represented  as 

=  ^Ri^vp,  -%-%:x  ‘Vsi),  (24) 

where  ^R  is  the  rotation  matrix  from  the  world  to  the  body  coordinate  system  [26].  This  last 
velocity  is  used  to  compute  the  joint  angular  velocity  of  each  leg  using  an  inverse  Jacobian. 
In  a  real  experiment,  a  foot  detects  its  landing  by  a  touch  sensor  and  changes  its  state  from 
transfer  to  supporting.  By  this  method,  the  robot  can  adapt  to  an  uneven  terrain. 
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4.5  Foot  Trajectory  Example 


Figure  15  shows  a  simulation  result  of  an  execution  using  this  trajectory  planning  algorithm. 
In  this  Figure,  the  robot  translates  along  a  circular  path  with  a  constant  body  orientation. 
Each  foot  trajectory  is  incrementally  generated  from  the  trajectory  template  with  enlarging 
or  shrinking.  This  result  demonstrates  how  dynamic  leg  motion  planning  and  execution  is 
done  to  embody  a  body  motion  command  with  rotation. 


5  Experimental  Results 


This  Section  describes  implementation  results  of  the  body  motion,  gait,  and  foot  motion 
planning  algorithms  (Sections  3,  and  4)  on  the  robot  system. 


5.1  Description  of  the  Robot  System 

The  Port  and  Harbour  Research  Institute  has  constructed  three  models  of  six  legged  un¬ 
derwater  walking  robots.  This  series  of  experiments  has  been  conducted  on  the  first  model. 
The  AQUAROBOT  hardware  system  consists  of  a  main  body  and  six  radially  symmetrically 
located  legs.  Each  leg,  made  of  anti-corrosive  aluminum,  has  three  degrees  of  freedom.  The 
axis  of  the  first  joint  is  vertical  and  those  of  the  second  and  third  joints  are  horizontal.  A 
disk-shaped  foot  is  connected  through  the  bottom  limb  of  a  leg  through  a  passive  spherical 
joint.  One  tactile  sensor  is  attached  to  each  foot.  Each  side  of  the  hexagonal  body  is  30 
centimeters  long.  The  limbs  of  a  leg  are  14,  25,  and  60  centimeters  in  length  respectively. 
The  motors  for  the  second  and  third  joints  are  mounted  inside  the  limbs  and,  through  har¬ 
monic  gears  and  bevel  gears,  directly  drive  the  limbs.  This  design  allows  their  weights  to  be 
distributed  over  legs  and  makes  water-tight  structures  easy.  The  powers  of  the  first,  second, 
and  third  motors  are  80, 120,  and  120  watts  respectively.  The  total  weight  of  AQUAROBOT 
in  the  air  is  280  kilograms. 

The  control  computer  is  an  NEC  PC-9821Xt/C10W  based  on  a  Pentium/90MHz  CPU. 
The  software  system  was  written  in  C-b-f.  The  sampling  time  is  50  milliseconds. 


5.2  Variable  Duty  Factor 

Figure  16  shows  the  snap  shots  of  the  walking  experiment  in  which  locomotion  speed  increases 
from  Parts  (a)  to  (c).  Thus,  the  duty  factor  decreases.  The  line  on  the  floor  shows  that  the 
robot  walks  from  right  to  the  left.  In  Part  (a),  duty  factor  is  about  1  /6,  and  only  |2  leg  (left 
behind)  is  in  the  air.  In  Part  (b),  duty  factor  is  about  2/6,  and  jtl  and  i|3  legs  are  in  the  air. 
In  Part  (c),  duty  factor  is  about  3/6,  and  |2,  |4  and  jt6  legs  are  in  the  air.  The  number  of 
legs  in  the  air  is  increased  to  produce  a  higher  speed  locomotion. 


14 


5.3  Variable  Crab  Angle 


Figure  17  shows  the  snap  shots  of  the  walking  experiment  in  which  crab  angle  increases  from 
Parts  (a)  to  (b).  The  line  on  the  floor  shows  that  the  robot  walks  from  right  to  the  left,  and 
the  direction  of  the  leg  tJl  (white  shank)  shows  that  the  robot  rotates  counter-clockwise  in 
the  top  view.  In  Part  (a),  |3  and  |5  legs  are  in  the  air.  In  Part  (b),  111  and  {13  legs  are  in  the 
air.  Thus,  {{3  leg  is  paired  with  {{5  in  Part  (a)  and  with  |1  in  Part  (b).  The  variation  of  the 
leg  combination  is  planned  to  make  a  highly  stable  gait. 


5.4  Walking  on  an  Uneven  Terrain 

Figure  18  shows  that  AQUAROBOT  is  stably  walking  on  an  unknown  uneven  terrain.  This 
motion  was  generated  by  the  method  described  in  Equation  (20).  The  foot  is  able  to  step  on 
and  off  an  obstacle  with  a  height  of  10  centimeters.  A  comparison  between  the  foot  motions 
in  Figures  15  and  18  demonstrates  that  the  foot  motion  algorithm  absorbs  differences  in 
foot  holding  height.  Although  the  current  control  system  does  not  include  a  body  posture 
stabilizing  feedback  using  an  inclinometer,  experiments  of  walking  over  an  uneven  terrain 
worked  perfect  as  long  as  the  walking  path  is  not  very  long. 

Through  our  prior  experiments,  we  understand  that  the  stability  of  a  walking  robot  often 
fails  by  an  elevation  error  of  a  landing  point  or  a  time  lag  of  touchdown;  because  it  causes 
an  inclination  of  the  body,  especially  when  fewer  legs  are  supporting  the  body.  A  larger 
stability  margin  and  more  supporting  legs  obtained  by  the  new  algorithm  make  the  robot’s 
performance  better  even  in  the  disadvantageous  condition.  The  correctness  and  effectiveness 
of  the  algorithms  were  thus  demonstrated  through  these  experiments. 


6  Conclusions 


The  body  and  foot  motion  planning  algorithms  investigated  here  handles  variable  speeds, 
variable  crab  angles,  and  motion  commands  with  superimposed  rotation  cases  perfectly.  This 
algorithm  has  a  striking  feature  in  that  it  always  maximizes  number  of  supporting  legs  in 
each  situation.  Thus,  a  large  stability  margin  is  obtained.  The  foot  trajectory  planning 
algorithm  can  deal  with  dynamic  situations  due  to  versatile  commanded  motions. 

Correctness  and  effectiveness  of  the  body/foot  motion  planning  algorithms  were  proven 
by  implementing  them  on  AQUAROBOT.  The  robot  walked  smoothly  with  a  variable  speed 
and  crab  angle  on  a  smooth  curved  commanded  path.  The  foot  motion  planning  algorithm 
for  an  uneven  terrain  was  also  proven  successful. 
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Figure  1:  AQUAROBOT. 
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Figure  2:  Control  Architecture 
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Kinematic  Phase  (|) 
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Figure  4:  Gait  diagrams  of  forward  wave  gaits(a  =  7r/6). 
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a=7i/6 

a=-7T/6 
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Figure  10:  Supporting  leg  chart  of  variable  parameter  wave  gait  {a  =  0). 
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Crab  Angle  =  -PI/6 


Figure  11:  Example  of  generated  gait  of  a  constant  crab  angle  case.  The  duty  factor  is 
decreasing  from  1.0  (on  the  left)  to  0.5  (on  the  right).  The  waves  of  lift-offs  propagate  as 
the  arrows  show. 
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Duty  Factor  =  2/3 


Figure  12:  Example  of  the  generated  gait  of  a  constant  duty  factor  case.  Even  if  the  crab 
angle  is  changing,  the  waves  of  lift-offs  propagate  forward  as  the  arrows  show. 
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Stability  Margin 


Figure  13:  Comparison  of  stability  margins.  The  minimum  values  of  proposed  omnidirec¬ 
tional  gait  and  forward  wave  gait  are  significantly  larger  than  that  of  backward  wave  gait. 


(a)  Trajectory  Plane  (b)  Velocity  Template 


Figure  14:  Trajectory  template. 
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Figure  18:  Walking  over  obstacle.  Broken  lines  indicate  the  trajectory  of  the  body  and  leg. 
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